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Abstract. This paper represents an adaptive rhythmic control for a snake-like robot with 25 
degrees of freedom. The adaptive gait control is implemented in algorithmic way in simulation 
and on a real robot. We investigated behavioral and energetic properties of this control and a 
dynamics of different body segments. It turned out that despite using homogeneous generators, 
physical constraints have an inhomogeneous impact on neighbor body segments. By analytical 
modeling of such dynamics, it may result in heterogeneous coupling of oscillators for a rhythmic 
control and impact scalability and synchronization effects of gait pattern generators. 
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1 INTRODUCTION 

Reconfigurable robotics recently attracted essential attention of researchers due to flexibility, 
developmental plasticity, behavioral and functional adaptability UJ. Modular robots with a 
high number of degrees of freedom are advantageous for industrial [fTSll . underwater and space 
applications, however are challenging for control of macroscopic locomotion [fT3l . There are 
two distinctive approaches for locomotive control in such multi-body systems: based on pre- 
destined trajectories, for example screw theory [14]; or based on rhythmic generators [il2i . In 
this paper we assume that independent reconfigurable modules form a multi-body snake-like 
organism, see Fig. [T] and we limit ourselves to adaptive locomotion control using rhythmic 
gait generator. The concept of rhythmic control can be represented as a periodic generator 
i = /(ai, a) and the coupling term (f)(x, (3) as e.g. a two ways coupled dynamic system with 
open boundaries of size n 

ii = f{xi,a) + (f){x2,f3), 
i.2 = fix2,a) + (f){xi,xs,l3), 

^3 = /(a;3,a;) + 0(x2,X4,/3), (1) 

= fiXn,a) + (f){Xn-l,(l), 

where x are state variables, a, (3 are sets of control parameters and i is associated with i-body 
segment. Goal of the rhythmic control can be thought of as adjusting the local coupling terms 
(3) Q so that the system (jlj) demonstrate a global synchronous gait pattern. The most 
of the state of the art works on the CML/CPG-based (Coupled Map Lattices/Central Pattern 
Generators) rhythmic control, e.g. [il6il . consider the coupling as homogeneous in relation to 
neighbor body segments. 

Implementing this approach in real multi-body systems, we face the problem of constraints, 
such as friction, limited motor torque, mass distribution over the whole system or a variation of 
mechanical couplings between segments. It results in two important consequences. First of all, 
due to complexity of analytic representation of such constraints, the focus of system's modeling 
is shifted to algorithmic approaches [21 J. Secondly, the same physical constraints have different 
impact on all segments of a multi-body system. The appeared different dynamics of segments 
can be associated with coupling terms and it leads to heterogeneous couplings between indi- 
vidual gait generators. This heterogeneity has an implicit form and appears dynamically during 
interactions between segments of a multi-body system and environment (in form of embodied 
cognition [17J). 

This work intends to demonstrate two above mentioned points: algorithmic approach for 
adaptive rhythmic gait generator and appeared inhomogeneity of coupling terms. This inho- 
mogeneity can be introduced as heterogeneous coupling terms for analytic CML/CPG-based 
approaches and in turn create some open questions of scalability and synchronization effects 
in rhythmic gait generators for multi-body systems. The scenario of this work originates from 
the large-scale European projects "SYMBRION" [2] and "REPLICATOR" [3] and is related 
to an optimal coverage of unknown area by a snake-like behavior with optical collision avoid- 
ance. This approach also addresses the problem of locomotive adaptability to the structure of 
environment and an energetic efficiency of control. 

The paper is organized in the following way. In Section 2 we introduce the adaptive algo- 
rithm for directional collision avoidance for snake-like robots. The implementation in Matlab 
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and results of the algorithm are demonstrated in Section 3. The algorithm was tested on a real 
snake robot shown in Section 4. The 3D locomotion gait analyses for snakes is explained in 
Section 5. The simulation of dynamics in Matlab/Simulink is demonstrated in the following 
Section 6. Finally, Section 7 concludes the work. 

2 ADAPTIVE ALGORITHM FOR RHYTHMIC GAIT GENERATION 

For the snake-like robot, see Fig.[T] we use the serpentine gait often also called lateral undu- 
lation: 

ipi^hit) = Ahsin{uht + {i - l)(ph) + '^h, (i = 1, n - 1), (2) 

where parameters Ah, (ph determine the shape of the snake and the parameter modifies the 
serpentine curve. Links are labeled by index i and h means that the gait acts in horizontal 
direction. The expression ([2]) represents the state-of-the-art solution [|5l, well known in robotics 
[l6l, [ISl, [!9l and is inspired by efficient locomotive behavior of real snakes. Since the embedded 
platform provides a limited computational capability, our goal was to reduce the complexity of 
control mechanisms to be able to run the algorithms in real time [fTTIl . Other requirements for 
this work were related to a minimal number of parameters changed during locomotion process; 
holding the direction to the target until the target is reached and a minimum of directional 
changes for the energetic efficiency. This type of locomotion strategy is motivated by possible 
scenarios in hazardous and dangerous areas, where the robot should optimize its own behavior 
for a fast coverage of the targeted area [|20l . 




Figure 1: Snake-like robot platform with 25 DoF, 15 IR distance sensors, one front ultrasonic sensor, 3D ac- 
celerometer and two-axes compass. 

Since a snake-like robot is not able to change rapidly the direction of movement, the gait 
planning and adaptation should be iteratively performed. To control a direction of motion, we 
use the following function f(d) ~ T, see Fig. [2} where dis a distance to target and sgn{phase) 
determines the branch of the function f{d) to use. The value of sgn{phase) indicates the turn 
left or right of the snake-like movement. This allows controlling the gait in a deterministic 
and efficient way. The value of f(d) and correspondingly ^Pi{t) is adapted according to the 
distance to the obstacle. Exponential form of the function provides smooth directional changes 
of the serpentine gait. Side distance sensors together with the tail sensor can be involved into the 
control process and additionally shape the serpentine gait. Such scenario is not inspired from the 
real snakes that use only the head and the skin tactile sensors but open interesting possibilities to 
control the shape of a snake-like robot. In situations where obstacles occur from the side these 
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Figure 2: Function f{d) = sgn{phase)foe d is the distance to obstacle, k is the critical turning parameter. 

sensors shape the amphtude of the corresponding links according to the distances. In order to 
change the values in a smooth way, another exponential dependence between distances to the 
obstacles and the affected link amplitudes is used: 

A{d) = e^" - Ama.. (3) 

where A is a new amplitude value calculated as a function of distance d, and A^ax is the 
maximum allowed amplitude for this kind of gait. If tail of snake detects an obstacle the angular 
frequency uj of the serpentine function (Eq. [2]) is also changed to avoid collision. 

3 IMPLEMENTATION 

The scenarios were first simulated in Matlab and finally implemented and tested on a real 
snake hardware (Fig.[T|). In order to measure the efficiency of the algorithms, we performed two 
major case scenarios for locomotion; one scenario based only on head distance to the obstacles 
(Bio-inspired) and another scenario where all distance sensors are involved along the snake 
body (Tech-inspired). 




(a) (b) 

Figure 3; Comparison of two scenarios with and without the adaptation, (a) Random walk scenario until the target 
is reached; (b) adaptive target direction (green arrows) following scenario. 
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Bio-inspired In the first scenario tiie snake stops if it reaches the target (green box). In this 
case the snake fulfill only the obstacle avoidance while performing random walk, Fig. [3]^a). 
Even if the target is reached after a while, this kind of exploration is very inefficient and energy 
wasteful. In the second scenario, additionally to the obstacle avoidance, the snake tries to follow 
the straight direction to the target, Fig.[3]^b). On a real snake hardware the moving direction can 
be determined by a compass device placed on the head segment. As followed from the Fig.[3| 
the second scenario provides much more effective way of reaching a target while avoiding all 
the obstacles. 

Tech-inspired The main difference between a real snake and a robot is the ability to percept 
the environment. Real snake uses different kind of sensors such as: tactile, smell, vision, acous- 
tic or infrared radiation sensors which are more or less sophisticated dependent on the snake. 
Smart combination of these sensor organs allow precise foraging and navigation. For robot 
snake, the number and the kind of sensors are limited due to hardware capabilities. In order to 
extend snake robot perception we use additional IR sensors mounted around the snake. These 
sensors have the same function as the sensors used on the head and allow the snake to modify 
the shape amplitude according to the algorithm described in Sec. |2] Therefore, the simulation 




Figure 4: Adaptive amplitude control by using side and tail distance sensors. 



was extended with this functionality. In Figs. |4] and |5| the amplitude is exponentially decreased 
if the snake come lateral closer to the walls or to the obstacles. The more sensors detect the 
obstacles the more intensive it affects the snaket's amplitude. 

4 HARDWARE IMPLEMENTATION 

The snake hardware consists of 25 servo motors assembled alternately in horizontal and ver- 
tical directions. Therefore, the snake can perform planar movement as well as limited spatial 
locomotion. The snake is controlled by a Programmable System on Chip (ARM Cortex-M3 
PSoC 5) microprocessor from Cypress, which directly generates PWM signals for servo mo- 
tors. All distance sensors are directly connected to ADC of PSoC chip; compass, sonar and 
accelerometer are accessible through I2C bus. The first real scenarios demonstrates the colli- 
sion avoidance by using only the head distance sensor (Fig. [6} (a)-(f)). The range of the IR 
distance sensors is approximately one and a half meter. The servo motor position is limited to 
30 degrees to fulfill a whole period cycle (27r/12) for locomotion in 2D. 

5 3D LOCOMOTION 

The adaptive algorithm for collision avoidance explained in Sec. |2] is at the current state 
applicable only for 2D locomotion. In order to transfer this idea to a 3D case scenario we need 
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Figure 5: Simulation of adaptive amplitude control algorithm. 




(d) (e) (f) 

Figure 6: Movement of snake robot towards the goal additionally performing optical collision avoidance. 

to investigate gaits that allow to move the snake in a 3D environment. In [lOJ, a good overview 
of different possible gait formulations and locomotion strategies in planar as well as for 3D 
environment is summarized. One of the promised gaits for a 3D locomotion is the combination 
of lateral undulation gait with the additional sinusoidal generator that controls the vertical gait. 
Therefore, additional parameter 0o is required that control the phase difference between the 
horizontal and vertical gait: 

'.pi^yit) = AySin{uj^t + {i-l)(l)^ + (j)Q) + T^, (i = 1, n - 1), (4) 

where index v means the vertical direction. Applying only the vertical gait the snake will 
perform a caterpillar- like gait. Combination of both creates a twist-like movement patterns like 
shown in Fig. |7J 
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Figure 7: Investigation of 3D gaits in Matlab SimMechanics without considerations of contact and friction forces. 

6 SNAKE DYNAMICS 

For studying the dynamics of the snake-like topology, we used Matlab Simulink with the 
combination of the SimMechanics toolbox. SimMechanics uses the second order Euler-Lagrange 
dynamic equations for calculation of dynamics [4J and allow efficient and fast multi-body simu- 
lation. The snake robot is modelled following the idea that modules are connected to the ground 
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Figure 8: Simulink model for 3D snake with 13 links arranged alternately along z and x axes. 



by six DOF joints and hence allow to translate and rotate each module along all six axis in space 
(Fig. [8]). This arrangement is necessary to simulate friction and body contact with the ground. 
A spring-damper system (Eq.[5]) is used to model the normal forces during the ground contacts. 
To simulate the hardness of the ground the spring coefficient k is set to a rather high value. The 
damping coefficient d is smaller in contrast to k and is necessary to damp out the oscillations. 

= -kpl - dvl Vp; < 0, (5) 

where i denote the link number and pi is the position and f * is the velocity component in z- 
direction. On a real snake, we use wheels on each module in order to mimic the friction forces. 
As pointed out by [5J, the friction of real snakes is much higher in the direction tangential to 
snake body length than the friction in the forward direction of the body. It is given through the 
skin shape of real snakes and reduce the side slipping. 
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To model these frictions and simultaneously not to overload the simulation, we use the most 
simple friction model in both planar directions: F}^^ = fJitF^ and FJj^ = UnF^, where in- 
dexes / and t denote longitudinal (tangential) and transversal (normal) directions. We do not 
consider viscose friction or slip-stick effects because the mass and the speed of the snake links 
is quite low and hence these parts can be neglected at the current state. Figure |9] shows a 
cascaded Simulink model, where colored borders show hierarchical structured contents of the 
corresponding blocks. 
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Figure 9: Cascaded model of snake in Simulink through structural levels marked by colored border ; (a) Struc- 
ture of a single link element (Level 1), (b) General contact forces block (Level 2), (c) Normal, longitudinal and 
transversal force model (Level 3), (d) Normal force (Level 4). 



The gait for the serpentine locomotion from Eq. [2]can be implemented by providing delay 
function blocks (see Fig. [10]) and simulate phase shift between each link. 
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Figure 10: Serpentine gait implementation in Simulink using delay function blocks. 



The scenarios are also implemented in the virtual reality (VR) environment by using the VR 
toolbox, which allows more realistic 3D visualization of our Simulink models. This frame- 
work enables the modeling of snake mechanics in a CAD software such as Pro Engineer and 
transporting the data to the VR toolbox, see Fig. [TT| 

In Fig. [12] we plot positions and phase shifts of different segments of a snake's body. It is 



well visible that boundary and middle segments have different dynamics related to the ampli- 
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Figure 11; Visualization strategy of snake locomotion in VR. 



tude and phase of the movement. The rhythmic drivers shown in Figs. [8] and 10 have typically 
homogeneous structure and well correspond to the CPG/CML structure shown by Eq.Q, how- 
ever the dynamics has an inhomogeneous form. Considering the snake robot from Fig. [6} we 
can attribute these differences in dynamics to physical constraints. Despite these constraints 
are the same for all segments, e.g. weakness of servomotors, they affect differently boundary 
and internal segments. Additionally, individual differences of modules, such as unsymmetrical 
distribution of masses or mechanical differences of modules, create some small variations of 
dynamics. 




(a) (b) (c) (d) 




(e) (f) (g) (h) 

Figure 12: (a,b,c,d)- Observation of three links (head, middle and tail) positions for snake build of 13 links. (e,fg,h) 
- X,Y dependent on simulation time. (a),(e) Phase shift ofixjl applied to horizontal gait. (b),(f) Phase shift ofir/i 
applied to vertical gate. (c),(g) Phase shift ofir/i applied to horizontal gait. (d),(h) Phase shift o/tt/S applied to 
vertical gait. 



Returning now to the analytical modeling of a rhythmic dynamics in the way of Eq.Q, 
we need to agree whether impact of constraints can be associated with the periodic generator 
x = f{x,a) or with the coupling term (f){x, (5). Since the periodic generator is independent 
of the spatial position of the segment, only the coupling term can be in charge of constraints. 
This interpretation makes also sense because all generators without coupling demonstrate the 
same unperturbed dynamics, and only coupling introduces perturbations. Thus, we need to 
agree that couplings of Eq.Q should be heterogeneous to reflect an implicit impact of physical 
constraints. However, the approach well-known in the CML community, e.g. [18,1 or [[T9l , 
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introduces primarily homogeneous couplings, this is a basis for several essential features of 
CML, e.g. a high scalability of coupled oscillators or multiple synchronization effects appearing 
in them. Obviously, that further investigations should be undertaken to express heterogeneous 
character of rhythmic control in multi-body systems. 

7 CONCLUSION 

In this paper we introduced an algorithmic framework for adaptive locomotion of snake- 
like robot organisms. The goal was to investigate a dynamics of such a multi-body system 
and to develop an algorithm, which can target a goal while avoiding the obstacles in a energy 
efficient manner. Experiments are performed in simulation and with real 25 DOFs snake robot. 
Several more theoretical issues related to homogeneous structure of CPG/CML-like models 
are considered, where we estimated that a proper model for a rhythmic control of a multi-body 
system should involve heterogeneous couplings. This is a preliminary conclusion, which should 
be considered more in detail, since this would essentially impact scalability and synchronization 
effect of rhythmic gait generators. 
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